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(57) Abstract: A plane detecting unit (3) of a plane detector has a line seg- 
ment extracting section (4) which selects a group of distance data points on the 
same plane from among distance data points forming an image and extracts line 
segments from the distance data point group and a region expanding section (5) 
which detects one or more plane regions present in the image from a line segment 
group of all the line segments extracted by the line segment extracting section (4). 
The line segment extracting section (4) draws a line segment (LI) connecting the 
ends of the distance data point group, seeks a point of interest (brk) from which 
the distance to the line segment (LI) is the largest, divides the data point group 
at the point of interest if the distance is a predetermined value or more, deter- 
mines a line segment (L2) by the least squares method if the distance is below 
the predetermined value, judges that the line segment is of a zigzag shape if a 
predetermined number of data points are continuously present on one side of the 
line segment (L2), divides the data point group at the point of interest (brk), and 
repeats the above processings. With this, planes are correctly detected at a time 
from the distance data including measurement noise robustly against noise. 
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A START LINE FITTING 

511 INPUT DATA POINT GROUP (p[0 n-1]) 

512 NUMBER OF DATA POINTS n INCLUDED IN DATA POINT GROUP n 
R END 

513 COMPUTE DISTANCE (dis) BETWEEN LINE SEGMENT L1 AND POINT 
(brk: DIVISION POINT) FARTHEST FROM LINE SEGMENT L1 

514 DISTANCE (dis)>max_d? 

515 GENERATE L2 BY LEAST SQUARES METHOD 

516 ZIGZAG SHAPE? 

517 PERFORM ADDITION TO RESULT OF LINE SEGMENT DETECTION 

518 DIVIDE POINT GROUP AT DIVISION POINT (brk), GENERATE TWO 
GROUPS OF POINTS, AND OUTPUT THEM 
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HrZfam&iT&v mi^fa<Dmx.l-£ftjf\p}<DWi^in (image row:-f^— v'n?) tc&V^ 

mm, ^m-r^mxh^o 

i\ ¥®<E>«&fc5fl*«(Js*T. ^S(seed region) ^V>5o )&3Bt* 

«^MJRi-6„ ckd^X^^oV^^, ±TW^-r5fr^lRl 

5o ^lt. ^iMM^mbT^ffiSff^^^^Ma^. mtft&mmo 
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N over-segmentationXf~iunder-segmentation^ift)(DPo^M^ s ^.CTU'^5o 't^-X^ ^ 

x\ mm^—^<Dm&, MXKfoKxmi&mzMmr^irz^m&mAtthn 
wt, mi9K^irm^^mKx^m^m^mK^^xmcmmKnmir^ 

o Bi^-^Hi^iLme Extraction)^*, _hj£b7U;5^ P^^\f^B>^P^rJ^2^h 

MWtco^mx&&cDici^cD¥-mti.xmML.xL,~£<>fc<9, ^Mm^co^-mxh^ 

^IZIt^XMlfcffiK^^^^^^ZT/^V^J* (Adaptive Line Fitting) £ 
^A-T^o Adaptive Line Fitting^ m^W,^4K^\^X, 5fc~f itm^A^^miW. 

mir^—^^m^h^ir^m^r.mm^x<>xnhti^m2(Dm^t^x<Dm 



WO 2005/088244 



23 



PCT/JP2005/004839 



v'^WB (zig-zag-shape) ^Tte£5*il^te\ ^KM^h^tl.Xv'— 

m^mir^mm^m\ ^ti^mM-r^tiz^x, f-^^si^t^^x 

mi^T(Dh(D^b^T^^(DM^^tir^t^x^, zJn&f— (p[ 

0- • 'ii-l]) bLXthmTZ (^T^Sll)o ^rbT, ^^P[0- • -n-1] 

2: yes) ^m^^tvx^M^m^ivx^m^mrir^ 

— i^^Vvto^^g§/jNfjg m i n _nJ^_h-efe§^^(S2:NO), t 1 — ^,£$£P[ 
0- • -n-1] ®-^©KP [0] iffi*©S^P [n-1] (S) Ll^fl ©I 

±% v ^fc* @ ^brkirbT^^L, ^OEgildist^ ffi*r§ C^r^S 1 3) 0 

^^{gitdist^^^^^^flj(DWf^imax_dJ;i9^V^^^^^(S14:YES) x 
— ^,&#P[0- • •n-l]^g^(^*'J^)brk^T20(D^-^^p[0- • 
•brk]&OT[brk- • -n-llt^f iJi"^ (^^°S18) 0 
— ^Egflf dist/^~^i^f \\(Dmm max_dJ;t9/h$V ^^fcfS (S 14 : NO 

) , ^-^^peo- • -n-m^^ir^m^mm^^xmm^m^co^m^: 

line&M (^5/^°S15) , ^(D^m^lme^1rmftL2&M2<DmfttLX%.)&ir 
So ^LT, 7*— ^^P[0---n-l]^-(D^L2^^-b-Cmaii-SZig-Zag-Shape 
X2b%frb*5fr%:m^-Z> (^^S16). Zig-Zag-Shape-C&V^^(S16:NOh 
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XTy'T'S 1 6 tC*3V ^T^S^S 1 /'H^^ s Zig-Zag-Shape-efe5^IJ 

, J^^S 13121*31 ^TfiEBIdistSr^fefc^f S ^Cbrk^T^— ^,£«r2o<£>^— * 
/£S$P[0- • -brk]^OT[brk- • • n-1] ^^-f"Ji~6 0 ^<D^^^°S18^T2o(D'7 ;2 — ^ 

ft*3, ^^X7°S13^T^-^£?¥P[0- • -n-1] Wffi^^i^Ll^m 

(D^Xitmm^fci^±KX'r— fMM-plO' • -n-i]^f"Ji-6J;5^b-ObJ;v\ 

#Cl3U ^s^Sl 5 i£:£Jt'5l|/h^;SI^J;5$B>£$C^'}£ (Least-Squares Line 
Fitting) (CoV^tfe^i-So fc5ni©f^»[0- • •n-ll/^X.^fc^ 9* 

[mi] 

x cos cc + y sin csr + ^ = 0 ---(l) 

n^B©7*— ^PP[0« • •n-l]©l^(x,y) ld*3V^T, HDBH;^^©^ 

i i 
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(2) 



[*3] 



1 — 25 
<3' = -tan" 1 - 2L_, = -(*cosar + ysincr) 



» i 

s^K**-*) 2 

1 



" i 



(3) 



'°S 16^it3^W^ (Zig-Zag-Shape) TOJ^&cfcoV vCf& Wt" 



3 0 ^(DZig-Zag-Shape^lJ^J-ef*, feSn^^T*— ^^P[0- • -n-l] ^[S:|£Line( a , 
dh xcosa +ycos a + d=Oft-$-Z.bfrlfz.t%, ^©f- ^,£jpP[0- • -n-l] ft, H2 

X.-Cig^L-CJI.tb^ l£ r* , zig-zag-shape^^ ^^Ij 9f t ft 
ZttfrKf— PMMPliJ&frmirZ&ms&Zo Hl22{i, Zig-Zag-ShapeWJ^S; 
*f\ ^l¥P[0---n-l]^ti:^Line(a,d, a ) ^StA^S C*7^S20) o 



<j ftpJtfe<DMiiM.th_ cr i 
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M1rZ> 0 t-^Pp[0- • -n-l]©5^©**0©^— ^P[0]s6S[iDlft©^*>6> 

0 0 

S22) Q r^-C\ sign(x)}3, x<Dm<DW^( + Xfe-)$:Mirm%LXfoK). sdist(i)te, P[i] 

.xcos a + P[i].ycos a +d£LTff #^^fcilL^Line^*5V vt\ i# g <D7*—?M>b<DjE 

0 

*Vi/Y\m:ZiV>vm\b\^o )<D%V>bm&lb~rz>(x^y7°S23) 0 ^ET, 

#J&*V>#<D%t7>hm&7 t — ^ltnJ:!9/J^V>#^ (^5/^824: YES) , ^(D^ 
fe^y0^sing(sdist(P[i]))^J;oT¥lJ®fb, ^(D^^^val^f^Ai-^ (^^S25) 0 

0 0 

val^^^^-^(^ : y^ 0 S26:NO) x val ^val^ftAE, iS^C#?^<D#^ 

o 

Hitcount^l^ftAb(^^7°S28) , ^—P&XV^&jJ^hm&^fV^b 
ET (^^S30) ^^7°S24^)^(D^a^M ; 5o 
— *\ ^5/7°S26^*dV^-C, val irval^^|^)C^'^(^^S26:YES), 7 s — ^ 

0 

^p[i-i]i:p[i]«. mmuneKtt^xmwMK&zbmwT&ti. mmu* 1 ?^^ 

r>^Mftcount^lo^^y^hi-^(^5/^°S27) 0 $&>^, Sic^^^cT)^^^ 
Mtcount^zig-Zag-Shapei^lJ^tb^fcfe(DS/jNCD^— ^fcin.cW A^V ^ 
^^^IJ^b (^5/^S29) , A:#V ^^^tt (^5/^°S29 : YES) „ Zig-Zag-Shapei 

/^/h<D^— ^fcin_cJ;9/h£V^^a3 (^^°S29 :NO) , ^^^S30^ 
513^ ^—^^^^O^^^Mei^^y^hLT^^^SSO) , ^^7°S2 

^ET, ^(Z)^5/7°S24^^(DMa§r, ?~9MXV^9<D%*7l/\feii£ i ?'--9& 

WcnKmrn-f-^xmn-, ^^um^nb^tcb^x^ false^^e-cms^ 
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a ,d) :xcos a +ycos a + d = Otf-$-X.hfrlfcb^, ^.(D^—^MM^^^LmeKM 

^<D£5*Zig-Zag-ShapeWJ*Q;Ste, ?H^s<£>^£>T K^T-CfT? 

BTfg-e^ 0 g|24« N Zig-Zag-ShapeWMS^f ^M^^ir^ 'uy?m 
XfrZ> 0 m24{C^kir£?\^ Zig-Zag-Shape«J#];S£B20f^ nf®^— ^,£;pP[0 

suu ^o^jsij^mvai^m7j-r^^^¥iJMUfP2i^, i^&<D^—?bjrmmi%2 
T^&pii-i^tetfttfamn®;$kvai b*mk^s&gm2zb, mk^mz. 

0 

3oVvTVal=Val (DM&lZ., #^Mt^^y^h1-3ig^#^^24^ ig^ 

0 

,£#^^24<D#^Witcount^/h7 y — ^^W^fl526^^^.^^mb^/J^7 ^ 
— ^^#Cmin_c^^i:bfei-§i:bW25^^i-§ 0 

i(DZig-Zag-Shape^JSlJ^a§P^*5(t^»]#^WT»J:5^^§o ^fa 

— ?&P[ilbUmUneb<D^10l(DmM&M, ^(DAE^COW^tHtlir^ W^M2 
2{3, 7 s — ^^P[i-l^(DUBUne^CO^m^Mir^^(DW^A^fh^bl^ 

m^^-^^P[i]^E^<^^^^A^$^^^^«^-^^|g-^i-^ 0 

it^§|323^, ^-^^P[i]^^-^^P[i-l](D±fEIE^(D^^i:b^b, I^C^f 
^feS#^^^^^^^24(D^r>^MScount^-r^y^^hi-§ff-^§rm 
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#Ct^ miOK^irm^U^U (Region Growing) 5 fcoVvrtBWTSo ^^*fc§SSP 
(D5p®(clMb"CV^^^^^!l(D5pB^(D^T«fe (Plane Fitting) fcJ^JBrU -^-X. 

<D-C*>«9, ^<D3^(D^^^'a'*^fi^fJ^a(seed region) £V^„ ^rbT, ^(D 
Apg^cD^Ttetf) (Plane Fitting) t) ¥U®rU ^1~3$l#^C¥ffi^3;*L3 

o 

m25«, mmm^m:mnir^fz.^(Dm^mx^ 0 025^1-^5^ mm. 

<Z)3^(D^^^^^a^bT»X$tl,fc^-r^ 0 ^b3;£<D$!^32a— 32c/^ib&3 
IS^^a^^o 5fcf\ ^(D30(D^32a-32c^J;«9l0(Z)^B(S2P¥B) 
P^^fe^o Jfcfc, fJ^«^^^llJ^^32aXf*32c^fJi^a^^-C^i-^ 
^^^tvx' — ^ 7 ^ij333^.^34f3i^oV , >"C N TOP^— <D^B-e^^?r^-r§o 

3¥®p"£j£#>, ¥BP ' £ HSf f So ^£I^M1-^^J;i9, ^31(^2^ @<d 
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mz-, *f—z&mp[$- • 'n-i^hmmznz^m^m^&mmirz^m (plane 

Fitting) „ Z*V&ffl8VXffijffi&3&l't'Z>J?& (Selection of seed region) „ 
frbffl$&&JcL'XT<^<ffl$$&%%!M (Region growing) , 

d^W^S±#V^©^ifSr|^V>'rSS3SLtiii~S^«!5ai(Post processing) t^oV^T 
;ki(nx, ny, nz) b4¥^<DfeWt<UZ.£oXTm^:(4)Xm&nZ>o 

BR4] 

^JC + + + ^ = 0 "(4) 

BR5] 

d) = £ (pf n + <*) 2 • ..-(5) 

i 

WcMMfen=m/ • m ■ , d=-l/ ■ m ■ bUX$Lt& 0 Z.Z.X\ ' • ■ fit, ^M-<D^:#£ N 
mJ3 N fT^J^t^<toT5i^—^^@^^<^^—/^feM!l (Cramer's rule) ^ 
ffl LTTtB (6-1 ) CD «t5 ^#^tL^^^^^CD^-efe§ 0 

[me] 

A • m = b • • (6 - 1) 

A = £p/Pf. b=£ Pi -(6-2) 

i i 

otfc, _hfE^(6-2) ^^i-A^bCDflt^rHffi-acD^-e, ^SrSff-Dt 
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Mm<D2^>(D^— ^hiU^—^b:^, 22fc^E— : E (p) % E (pp 

T 

A«- A + nE(pp 7 ) , b<-b + n£(p) .-.(7) 

-^^#(D^B^@^^O^^V ^^t?B^g^(Z)2l|^^i (RMS 
(root mean square) residual) (£IT, rms£V>5„ )^TfB^(8) \C£VWWiirZ)Z.b& 

cms] 

rmj(p! • • -p n ) - (I £ (pfn + df >th_rms ■■■($) 

_hte(8) ^-r^-, #7*— p^Mfctc^m^hn^m^m^^m^ 

1 n 

^CiE, ^«(seed region) ^^i-^^fe&r^^^^^^tS^Ci-^^^ 
,1,1 )T?fcot, SV^IBHl , 1 ), (1 , 1 ) ^it^Pf^M^-btB-X- 

1 2 3 1 2 2 3 

fofoK&tfZ>mm&m : &^~f~<<>7*ry?x (index) Sr^iVC&t^ m%S2.ftJ5\P\<D*r 

—?mK&tfz>Mfrxhz>m&, ^.(D-oT^^itm^xm^Kxmm^x^ ^ 

Sfl^^SrJttWSo '^m«5bbfc^(^^S32:YES), _htB*W)£- 
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12 3 

y°S33) Q ^LT, ©2t¥^t^rms (1 ,1,1 ) WRtflcmft^ 

12 3 

rms 

rms 

1 4 

4 

rms 

^^^«¥ffi^^^^-^^Mffb(^^^s38) % srj ? ^ , 7 i s'^'s3536=»e>©«miSr*i 

^ofc^>(^^7°S36:NO) , *^:/S31<DM^M«9> SU^^H^^tl'So 
^TO^rms^jff ^® Wit (th 1) *i»^*>3#^fc<D^r©|ft# (P) Srlnl— 

rms 
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mmm%m-tz>m, & n <dub. (m&) ©«s^t (end point) w BP^^gggiD^ 

fit # Bf fe<D MiMX t)/h$v ^ ftt a <Dt&ft& ¥®p£ 1*1 — WCfcS £LT 

So ^mJfU^,(D2m^^mMxms^M^t. m27A<DW.J&LafrhMlkZ> 

¥-mJjU^:<V2m WS^rms (La) ^i:bLTg|27B(Dil:^Lb^^^^^ffi^@ 
^(D2^^i^BS^rms(Lb)(D^-^^V\ i~&;b^ H27A<DJ;5^ WMl^at^- 

i<DfS^0f^® Wit (th 2) ¥ffi^iJifi-§^^^0*bv n 

rms 

o 

jifBo^fe^^*Dft§^ii*p^^^*5v>-c^ijffl$^wft(th 2)«, mm. 

rms 

Under-Segmentation, Over-Segmentation© f^jH^^CS^K Si^^*^5^gt'T ? 

^x^mmmmxn, rm^z o> k £«9 mm (th 2) ^^--a-iws/^x 

rms 

th 2 = max(th 3, d sigma(l )) -"(9) 

rms rms maha 2 

r^-C. th 3^Hfg(th 2) <DTm&feM1-%7£Wt. d ^^^yt^jiggi, 

rms rms maha 
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sigmaOi*li#tf>#ffc£rie-f o M^&^<^&7>—?te, $l^5>iitsigma()^^:< 

, mmth 2) fgJKl&§gt!:B|-r5fF^ttHdS^#<J5:5o 

rms 

rr-e« N si g maOi!bT±fE^: (2) xmznzmm^n^t^—? fi,<Dm^<Dmn 

fit rms 
rms 

±&©3MfcStf«B$l#ifctt\ 028(Dj:5i^^m-r^-^^-e#§o overlapC 

) k j k 

fitPlaneO , 1 , 1 _h|E^(4) — (7) ia!3Am=b©ilrt*¥S^7^- ^n, d£ 

12 3 

trUtU _h|E^:(8)^J;«9ftt±l$tvfcA, b^i«9, ffH^h/W ,1,1 ^m\C7Av 

12 3 

rms(l , 1 , _hfE^:(6)^fflbT3^:<Dll:^^T^*DV^T, ¥ffi^@^»2 

12 3 

^Apl^^^rms(Dfii^^m-t- ; 5P#:'eS> ; 5o *fc, removed ,1,1 lines[i], lines 

12 3 

[i+i]i , lines ii+2]fabmm&&ni$ir%b\^xmu&tittti : etiwni , 1 , 1 ^ 

2 12 3 

bte, _hfE^:(6-l) ^^i-^rtL^Wf^Mt^^^h/V-efeS, add(A, b, 

_hfB5£(8) IZXQ, AkbKWMJme<D*£— *l/h%Mx.%mWCVfoZ> 0 Solve(A, b)tt, 

Am=b«#Sffc^m«r3ft«>, _hfE^(4) — (7) l^W®'^— *n, d^f-r^-T^o 

select(open)}3\ ^fci£^$3<£>lo>fe^ open<D^#^fcl^;ilO<D^W^r-3rjS$R. 

*f-5B8S5rC*>5o index(l m^\Xtenfc$5tf%l (D4>"fv?*&7&1-m 

l l 

%fcV$>Z>o Tfefcu neighborGndex)}*, ^ibtl^yfV^t-igt^yfV^^, 
^lx.^index-1, index+l}Sr3gi"M^-e*>S 0 
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mnmiTZfamiPost processing) Srfr5o ^©ffiflffitS^Itii, 0!l;tf£_h3£ 
fc#¥®(D^#<D{gilt^—^ (pixels) ICJSV^ H^JSL-CV^^ffii^ BIS 

mm^^T^tM^mm^-rm^m, ei3ob«, wm**. wm*y. 

d^i^tttii^Si-t^l- ¥®K# : &"t"5fc&4'L3'7 ? — *j£ifc&>kIiDlMrtfeffiUfc 
t>©Sr^-r„ H 30B f^-r «t «9 x-htit' ¥M*SrBI 30 

tf:®Fl£fcJ\ l^(D^mST3^mU^tlX^^ 0 g|31B^ Wlk^kW^^tW^^O 
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fc, tttijCOj^SC^^) (correct extraction(horizontal)) ^f^\n\(Df—^\%\^ 

tttrJO^^C^ii:) (correct extraction(vertical)) f3\ $l\jj\p}<D c f— ^IJ^^OV^T 
CDtfomtDf&^&^iTo No. 1— No. 5te. JiMLfcZig-Zag-ShapeWJ&iS&r 

Zig-Zag-Shape^JMy^a^fof^|IM(D^t8^^ott§¥ffi^t±]^ax»^#^ 
-To 

s Wdtitoft (Line Fitting) K&\t*X&fe<Dltlto<DM4&'<?*~*m^d$rk%< , TZ> ( 
max_d = 25, 30) t^.tH^^T^'O. B§fgmaxjl/h£<i-5(max_d= 10, 15)^ffi^ 

^[B]_bi-So rtbi-^jb-C, «§W<DJ;5^ ^W^fiE^a^Ai-^^^J: 

A^Pfgmax_d=30^SL-Ct, ffitLfc^mM*^-r-i:^^^o 
HtLX^, SHitmax_d£/h$<-r3^ 7-fX^#^(tT^t±i^^<^oTL*5 

MVfcM, ^H«^^^^®»J(£g^-^iJ)^^a^ttmL-fcF!l^-ro HI 

max_d^X^< LTt> , J5 ^/-f X©M^ A^ V ^^OfJ|^o Tt>^^^^ ft $ 

tiX\^^bl)>t>frZ> 0 

bi33^:tj«ei34«, ^n^m^m^n^tm\m^h3^wm^—^M 
n\^x¥-mtkmisfc.m$:^irmxfo% 0 m33Rxfm34\c^ir£y^ vvf m>w& 

h^X<Dm^^^t^X^.mX^X^^ 0 £fc, H34B«, *ffi<D— 
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& ^wMx*^xh i?^j?i&xhz> m&\a-± , /-fx-e^c Wk^m 

w^B^\^mm^^^xm^<D^^^mxh^bi^mx^ 0 3^ 

^mn^^bxmm.^xh^\ ^^^—^n^^b-r^m^-Ku. mmm 
mz.mmvxmmirz>~bhpjmx&v, ^^—^yhwm^mmw-^ 
\^xfcmir%~bK£<9mmirz ) ~bh»imx&% 0 
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m^mm 



en 



[2] 



[3] 



[4] 



[5] 



5. ±mm^tn^n, ^mmi^m^Mtcmmr^ ^m^mmmm^m 
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[6] 



[7] 



[8] 



[9] 



6. ±m^mm^m^m^ m-(D^m^mi-^tm&n^m±(Dm^i 

m-rs tosh m #^^35 \-m~tz> 



3KIH.0 



[io] io. ±mm^m^n, 2-D<DM^^x^umi^oxmm^w\ir^m 
^mi^xm^mm-r^ 



[12] i2. 37^(D^m^—^h^m^mir^m^w,^mcm^x, 

37^^mxm-^m±Kh^tmm^n^mr-^^mmKm^mmir^ 

xtan^tt Hi x@-m, satt^— i^ttM ft KBft&fti m-r^ 
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[i3] i3. ±is^ttmx@-e«. ±mmm c f—^^m(DmmKm^m—^m±Kh 
[14] i4. ±mm^mnnx^ ±tm—^m±fc&%tmmtsnz>mm'r—?&m 

[15] 15. _h|E^ttmX@-e«, _h|EI^-¥ffi-hi-^^^tt^£ggt-x— 

'^#m^-rsft^^tBH^i3ii?s*<z)TO^m^&o 

[16] 16. ±fE¥ffi^$i«X@-ef3\ H3— ©spiBlcJR'rs^fije^nSl^-h^jlft^Sr 
[17] 17. XfB^ff^r^B^Mi-^ra^-^^^^V^T, ^H»r¥ffi£<E>rat 
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[is] is. _htE¥ffifs^*£^x@-e«, mfr\z£V)m'§iz>¥ L mb±m&m¥ L mb<Dmmz 
[i9] i9. &&&jiz.nmirZ)V27$yhmmz$5\^x, 

[20] 20. tt^mm^xmm&tt^ir%mmtt j *^&$:^irz> 



[21] 2i. ±mmmttttmz, ±M^xjt<D^m^-^m%irzmK±Mn^m\' 
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Input: pts : vector of points, n : number of points, 0t,d, (J : parameters and std-dev of fitted line. 
Output : true if curve contains a zig-zag- shape, false otherwise. 
Sequence : 

if o > threshv then 

valO =pts [0] cos a + /?fc[0] .y* sin a + d 
count = 1 

for/ = 1 to (n-1) do 

val =pts[i] .x* cos a + pts[i] .y* sin a + </ 
if {vol* valO <=0) then 
vaJO = val 
count ~- 1 

else 

count = count + 1 

if (cottftf >= min-points-for-zig-zag-shape ) then 

return true 
endif 
endif 
endfor 
endif 

return false 
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Algorithm FindSccdRegion 

Input: linesfij: vector of lines for esch image row (or column) / , 

n : number of image rows (or columns) 
Output : set of lines (seed region) or empty set (no seed found). 
Sequence : 
for j =0 to (n-3) do 

for J j in lines[i] do 

for 1 2 in lines do 

for 1 3 in lines[i+2] do 

if overlapfl ) J 2 ) and overlap(l 2 ,l 3 ) then 
(n,d) = fftPlane(l 1 ,l 2 ,J 3 ) 
if rmsOt J 2 ,l 3 ) < thresh / m then 
seed={l lf l 2 J 3 } 

remove(lj ,l 2 >h) 
return seed 
endif 

endif 
endfor 
endfor 
endfor 

endfor 
return {} 
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Algonthm RegionGrowmg 




Input: region : set ot lines as seed region, 




Imes[ij : vector of lines for esch image row (or column) 7 , 




n : number of image rows (or columns) 




Sequence : 




A=0 9 b=0 




for i m region do (A,b) = add(A,b,l) endfor 




(n,d) = solve(A,b) 




open = region 




wniJe not empty(open) do 




/ 7 = select(open),open = open - {Jj } 




tor / //j neignoor(inaex( 1 1 )) do 




tor y 2 in hnesfij do 




if overlap(l } J 2 ) and rm$(l 2 ) < thresh2 m$ then 




^region + {1 2 }, 




(A,b) =add(A,b,l 2 ), (n,d) =solve(A,b) 




open = open + {1 2 } f 




remove(l 2 ) 




endif 




endfor 




endfor 




endfor 




plane = {n 7 d,A,b f region} 




planes = planes + {plane} 
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